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摘 要 : 针对 传统 风 油 驱动 、 前 轮转 向 的 高 地 隙 喷雾 
灵活 性 差 等 问题 ， 本 人 研究 提出 了 一 种 适用 于 无 人 各 驶 


机 传动 效率 低 、 碳 排放 高 、 环 境 污染 、 智 能 化 水 平 低 、 
的 高 地 际 四 轮 独 立 驱 动 (Four Wheel Independent Drive, 


4WID) 喷雾 机 。 其 采用 混合 动力 、 前 后 双 转 向 桥 的 4WID ， 转 向 半径 小 ， 前 后 轮 的 运行 轨迹 高 度 一 致 ， 能 够 
减少 田间 植保 作业 时 的 压 苗 现象 。 考 虑 水 田 极端 作业 环境 下 驱动 轮 的 滑 移 、 陷 坑 等 问题 ， 基 于 喷雾 机 线性 
时 变 的 运动 学 模型 (LTV)， 构 建 了 考虑 驱动 轮滑 移 的 分 层 路 径 跟 踪 控 制 。 上 层 模 型 预测 控制 (Model Predic- 


tive Control, MPC) 需 根 据 预期 路 径 、 车 辆 当前 位 置 ， 


获得 喷雾 机 的 转向 角 和 运动 速度 ， 实 现 路 径 跟踪 。 下 


层 以 模糊 控制 和 积分 分 离 PID 控制 构建 驱动 轮滑 移 控制 咒 ， 从 而 实现 路 径 跟踪 、 运 动 速度 、 驱 动 轮滑 移 的 有 


效 控制 ， 提 高 了 喷雾 机 在 复杂 作业 环境 中 的 稳定 性 条 


[0 路径 跟 踪 精 度 。 采 用 Adams/Matlab 的 联合 仿真 结果 表 


明 ， 在 复杂 的 工 况 条 件 下 ， 喷 雾 机 驱动 轮 的 滑 移 率 依然 控制 在 +20% 之 内 ， 防 止 驱 动 轮 发 生 过 度 滑 移 对 车 速 


和 转向 角 产 生 不 良 影响 ， 有 利于 喷雾 机 稳定 性 的 提 姑 


|。 本 喷雾 机 能 够 快速 准确 地 跟踪 期 望 路 径 ， 与 未 考虑 


驱动 轮滑 移 的 控制 相 比 ， 能 够 适应 更 加 复杂 的 工作 环 ] 


卉 ， 跟 踪 精 度 有 明显 提升 。 


关键 词 : 前 后 双 转 向 桥 ; 四 轮 独 立 驱动 ; 模型 预测 控制 ; 模糊 控制 ; 滑 移 ; 路径 跟 踪 
中 图 分 类 号 : S24 文献 标志 码 : A 文章 编号 : 202105-SA006 


引用 格式 :王子 杰 , 刘 国 海 , 张 多 , WER, 姚 震 , 张 贺 . 高 地 隙 四 轮 独 立 驱动 喷雾 机 路 径 跟踪 模型 预测 控制 中 . 智 


慧 农业 (中 英文 ), 2021, 3 (3): 82-93. 


WANG Zijie, LIU Guohai, ZHANG Duo, SHEN Yue, YAO Zhen, ZHANG He. Path following model predictive 


control of four wheel independent drive high ground clea 
Chinese with English abstract) 


1 引言 


当前 ， 无 人 农机 自动 驾驶 与 无 人 作业 成 为 未 
来 智慧 农业 的 一 个 重要 研究 方向 ”。 农 机 装备 已 
被 列 为 “中 国 制 造 2025” 的 十 大 重点 研究 领 
域 “。 然 而 ， 目 前 绝 大 多 数 的 农机 装备 采用 燃油 
驱动、 传统 机 械 传 动 ， 存 在 传动 效率 低下 、 控 制 
形式 单一 、 转 弯 半 径 大 、 姿 态 控制 难 等 问题 ， 整 
收 稿 日 期 : 2021-05-15 ”修订 日 期 : 2021-06-07 
基金 项 目 : 国家 自然 科学 基金 项 目 (51975260) 


rance Sprayer[J]. Smart Agriculture, 2021, 3 (3): 82-93. (in 


体 技术 水 平 较为 落后 ， 而 且 普遍 存在 农机 作业 时 
间 长 、 农 机 手 劳动 强度 大 以 及 安全 隐患 的 问 
题 “”。 无 人 驾驶 农机 借助 卫星 定位 导航 系统 ， 能 
更 好 地 适应 复杂 田间 作业 环境 ， 显 车 提高 农机 作 
业 精 度 ， 避 免 作业 重复 或 遗漏 ， 提 高 农业 生产 效 
率 和 智能 化 水 平 “。 同 时 ， 能 有 效 地 降低 农机 手 
的 劳动 强度 ， 减 少 人 力 成 本 ， 也 可 以 避免 在 植保 
施 药 过 程 中 人 与 农药 可 能 的 接触 。 
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BEAT BAER ee TA BEAR LA Lt 


高 地 阶 喷 雾 机 (图 1)。 其 采用 前 后 双 转 向 桥 、 轮 


究 问 题 ， 控 制 算 法 的 优 劣 将 直接 影响 农机 自动 导 
航 的 精准 度 和 农机 装备 的 稳定 运行 ， 进 而 影响 到 
农机 作业 效果 和 生产 效率 。 农 业 复 杂 的 作业 环境 
不 仅 会 降低 农机 装备 跟踪 路 径 的 精度 ， 同 时 会 对 
农机 装备 安全 运行 产生 不 良 影 响 ， 甚 至 造成 农机 
侧 翻 倾倒 事故 发 生 汪 。 近 年 来 ， 国 内 外 研究 者 针 
对 路 径 跟 踪 控 制 进行 了 深入 的 研究 o Song 
等 ”考虑 纵向 速度 和 道路 曲率 对 低速 复杂 驾驶 
条 件 下 喷雾 机 轨迹 跟踪 稳定 性 的 影响 ， 设 计 了 时 
变 模 型 预测 控制 (Model Predictive Control, 
MPC) 器 以 提高 轨迹 跟踪 精度 。Liu 等 ”提出 了 
一 种 新 的 基于 双 连 续 投 影 法 的 无 模型 自 适应 控制 
算法 来 解决 装置 的 横向 跟踪 控制 问题 。Lenain 
等 通过 考虑 扩展 的 运动 学 模型 明确 考虑 了 滑 
动 效 应 问题 ， 提 出 了 一 些 依赖 于 自 适 应 和 预测 性 
并 基于 观测 器 控制 的 发 展 ， 专 用 于 农用 拖拉 机 的 
自动 引导 。 张 华强 等 '" 提出 了 基于 纯 追 踪 算法 
的 路 径 跟 踊 控 制 改 进 算法 ,通过 群 粒 子 算法 实时 
确定 纯 追 踩 模 型 的 前 视 距离 ， 提 升 农机 作业 时 的 
直线 跟踪 精度 。 王 辉 等 "提出 了 一 种 基于 预 瞄 
追踪 模型 的 农机 导航 路 径 跟 踪 控 制 方法 ， 有 效 提 
高 了 农机 对 复杂 路 面 的 抗 干 扰 能 力 。 刘 兆 明 
等 1 针对 雷 沃 高 地 际 喷 杆 喷雾 机 提出 了 一 种 以 
位 置 偏差 和 航向 偏差 为 状态 变量 的 直线 路 径 跟 踩 
控制 算法 ， 喷 雾 机 能 够 自动 完成 直线 、 地 头 转弯 
行驶 和 喷雾 作业 。 白 国 星 等 从 非 线 性 模型 预 
测控 制 出 发 ， 提 出 了 两 种 实时 性 优化 方案 ， 保 证 
控制 器 在 跟踪 曲率 、 航 向 变化 较 快 的 参考 路 径 时 
的 控制 精度 。 刘 正 铎 等 “ 提出 了 一 种 基于 非 线 
性 模型 预测 控制 的 路 径 跟 踪 控制 方法 ， 有 效 减 小 
横向 偏差 。 上 述 文献 均 未 考虑 复杂 作业 环境 下 ， 
农机 滑 移 对 农机 稳定 运行 程度 和 路 径 跟 踪 精 度 产 
生 的 有 影响。 因此， 克服 农机 在 复杂 恶劣 多 变 作业 
环境 下 打滑 、 陷 坑 等 问题 ， 实 现 智能 农机 的 稳定 
运行 与 高 精度 跟踪 是 农机 路 径 跟 踪 控 制 的 首要 任 
务 。 为 解决 上 述 问题 ,课题 组 研制 了 一 球 四 轮 独 
立 驱 动 (Four Wheel Independent Drive, 4WID) 


ax FL LA} Ai sk AWID 的 底盘 系统 ， 如 图 2 所 
示 号 ， 具 有 驱动 力 强 、 转 向 半径 小 等 优点 。 液 
压 推 杆 、 连 杆 的 辅助 转向 装置 能 保证 喷雾 机 在 泥 
学 田间 或 水 田 作 业 时 ， 前 后 轮 运 行 轨迹 高 度 一 
致 。 以 此 4WID 高 地 际 喷 雾 机 为 研究 对 象 ， 采 用 
MPC 实现 对 其 路 径 跟 踪 控 制 。 同 时 考虑 到 喷雾 
机 在 泥 尝 田间 作业 时 驱动 轮滑 移 对 路 径 跟 踪 控 制 
的 影响 ， 加 入 模糊 控制 器 对 驱动 轮 的 滑 移 率 进 行 
控制 ， 提 高 路 径 跟踪 精度 。 


Al 高 地 阶 四 轮 独立 驱动 电动 喷雾 机 


Fig. 1 High ground clearance four wheel independent drive 


(4WID electric sprayer 


轮胎 


液压 推 杆 


后 转向 桥 
注 : Vi,V,Vi,V4 为 四 个 车 轮 的 线 速度 ,q 为 前 轴 转 向 角 BAG ah 
转向 角 , 工 为 车 身长 度 ,a 为 前 转向 桥 到 质心 的 距离 ,bp 为 后 转向 桥 
到 质心 的 距离 ,A 是 前 转向 桥 的 中 点 ,B 是 后 转向 桥 的 中 点 ,S 是 
车 辆 质心 

图 2 前 后 双 转 向 桥 的 4WID 驱动 底盘 
Fig. 2 4WID drive chassis with front and rear double steer- 


ing axles 
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2 喷雾 机 运动 学 模型 


2.1 喷雾 机 差 速 转向 运动 学 模型 


高 地 隙 4WID 喷雾 机 通过 独特 的 前 后 双 转 向 
桥 结 构 、 轮 纹 电 机 差 速 协同 实现 转向 ， 转 向 半径 
小 ， 且 前 后 轮 运 行 轨迹 高 度 一 致 。 喷 雾 机 具体 参 
数 如 表 1 所 示 。 
表 1 4WID 高 地 隙 喷雾 机 参数 


Table 1 Parameters of 4WID high ground clearance sprayer 


参数 数值 
质量 /kg 2170 
宽度 /m 1.95 
长 度 /m 1.7 
轮胎 半径 /m 0.47 
驱动 轮转 动 惯 量 /(kg:m) 0.66 
连 杆 长 度 /m 1.49 
喷 杆 长 度 /Am 12 
药 箱 容量 /L 500 
喷 施 量 /(Lmin ) 5~10 
最 大 转向 角 /(?) 24 


通常 情况 下 ,喷雾 机 进行 植保 作业 时 ， 行驶 
速度 较 低 ， 因 此 本 研究 不 考虑 喷雾 机 侧 偏 以 及 横 
摆 的 稳定 性 问题 ， 仪 考虑 其 路 径 跟 踊 问 题 。 按 照 
图 2 喷雾 机 底盘 驱动 结构 ， 根 据 Ackermann- 
Jeantand 转 向 原理 " ， 可 得 喷雾 机 转向 角 和 四 了 驱 
动 轮 速度 关系 如 公式 (1) ~ (4) 所 示 。 


1 W tana 
r: M a 2b ) by 
Hert 1 dle (2) 

cosa 2a 

= 1 W tanp 
=r cosp 2b ) (3) 

E 1 | Wtanf 
Ms Oh aap © 2b ) ta) 


其 中 ，a, 6 分 别 是 喷雾 机 的 前 轴 转 向 角 和 
后 轴 转 向 角 ，(?); 4 是 前 悬 架 中 点 到 喷雾 机 质心 
的 距离 ，m; 2 是 后 悬 架 中 点 到 喷雾 机 质心 的 距 
离 ，m。 喷 雾 机 的 底盘 结构 对 称 ， 在 转向 时 前 后 
桥 转 角 相 等 ， 方 向 相反 。F 是 喷雾 机 行进 速度 ， 
m/s; 太一 太 分 别 为 喷雾 机 四 个 驱动 轮 的 速度 ， 
m/s。 通 过 控制 喷雾 机 四 个 驱动 轮 的 速度 从 而 达 
到 控制 车 速 和 转向 运动 ， 实 现 预期 路 径 的 跟踪 。 


FH PM Ss LAE AY PE lb eS AR, RS DK 
动 轮 的 差 速 转向 ， 在 通过 泥 活水 田 或 陷 坑 路 面 时 
不 能 实现 可 靠 转 向 并 保证 前 后 轮 轨迹 高 度 一 致 ， 
因此 采用 了 连 杆 及 液压 推 杆 的 辅助 转向 装置 ， 在 
复杂 环境 下 也 能 减 小 转向 角 受 到 路 面条 件 的 影 
响 。 转 向 角 5 和 液压 推 杆 长 度 7 的 关系 如 公式 (5) 
所 示 。 


Al, = 


-0.000136? + 0.0256, 0<6, 
0.0000966? + 0.02746, ô <0 


2.2 喷雾 机 驱动 轮 动力 学 模型 


在 复杂 的 道路 情况 下 ,为 了 更 好 地 分 析 了 驱动 
轮 的 状态 ， 建 立 如 图 3 所 示 的 喷雾 机 驱动 轮 动力 


学 模型 。 
“oo 


(5) 


Fai 
图 3 喷雾 机 了 驱动 轮 动力 学 模型 
Fig. 3 Dynamic model of sprayer driving wheel 


忽略 空气 阻力 等 干扰 ， 可 以 得 到 喷雾 机 驱动 
轮 动力 学 方程 ， 见 公式 (6)。 


Jw =T,- RF,-T, (6) 
OK oN ROG AE RIRN: 
T,=Jw+RF,+T, (7) 


其 中 ,ww 为 驱动 轮 角 加 速度 ，rad/s*; T, AIK 
ZIRE, Nem; R 为 驱动 轮 载 信 半径 ，m; 7 为 
OMe, Nem; FIRAN, N; JH 
驱动 轮转 动 惯量 ，kgm。 如 公式 (8) Prax, M 
是 喷雾 机 驱动 轮 质 量 。 


MR? 
i= (8) 


2.3 喷雾 机 的 线性 时 变 运动 学 模型 

选取 喷雾 机 中 心 点 的 纵向 速度 作为 整 机 纵向 
速度 。 选 取 喷雾 机 在 全 局 坐标 系 下 X 轴 的 位 置 ， 
Y 轴 的 位 置 和 航向 角 9 为 状态 量 ; 喷雾 机 纵向 速 
BE v AFR fA APE th to ESE ALR BEN 1. SEF 
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运动 学 原理 ， 可 得 喷雾 机 整 机 速度 、 转 向 角 、 全 
局 坐标 系 中 位 置 关系 如 公式 (9) 所 示 。 


X =Vv,COos@ 

Ý = vsin o (9) 
. 2vtan0/ 

9 = a 


选取 状态 量 x= LX, Y, o] 7， 控制 量 u= 
Lv, ô] 7 ， 则 喷雾 机 状态 空间 方程 为 : 

x=f (x, u) (10) 

为 简化 模型 ， 将 模型 线性 化 ， 选 取 参 考 状态 
量 x。， 利 用 泰勒 公式 在 x 处 展开 ， 将 公式 (10) 
改写 为 增 量 形式 ， 可 得 到 如 公式 (11) 所 示 关 于 
状态 量 x 误差 + 的 状态 空间 方程 。 


oS : of of 
E Se er ps (Gas 
= = (天 (U = u) (11) 


= Ax + Bu 
EP, A Baril foe x, 2 的 雅 可 比 
和 矩阵。 
通过 前 向 欧 拉 法 将 公式 (11) 离散 化 ， 此 
喷雾 机 运动 学 模型 可 近似 视 为 一 个 线性 时 变 
(Linear Time-Varying Systems, LTV) 系统 ùm 
AK (12) 所 示 。 
¿(k+ 1)- x(k) 
T 


= Ax(k) + Bu(k) (12) 


可 得 ， 
R(k + 1) = (1 + TAX (k) + Bik) 1s) 
=A, ,X(k) + B,,u(k) 
其 中 ， 
[1 0 -msinp 
A,,=|0 1 Tv, coso 
LO 0 1 
| Tcoso 0 
有 = Tsing 0 
, 2T tanô, 2Tv, 
1 1cos 0/ 


3 LTV-MPC 路 径 跟 踪 控 制 

采用 如 图 4 所 示 的 分 层 控制 结构 控制 喷雾 机 
跟踪 路 径 ， 上 层 控制 需 采 用 线性 时 变 模 型 预测 控 
制 (LTV-MPC) 实现 喷雾 机 跟踪 路 径 ， 下 层 控 


制 器 中 考虑 驱动 轮滑 移 对 喷雾 机 跟踪 精度 的 影 
响 ， 采 用 模糊 控制 对 驱动 轮 的 滑 移 率 进行 控制 ， 
通过 积分 分 离 式 PID 控制 减少 喷雾 机 在 局 动 过 程 
中 所 产生 的 较 大 滑 移 率 。 


3.1 路 径 跟 踪 的 MPC 


MPC 具有 系统 考虑 预测 信息 和 处 理 多 约束 
优化 问题 的 能 力 ， 被 广泛 应 用 于 无 人 驾 邓 的 路 径 
跟踪 控制 上 "5 ，MPC 算 法 拥有 “前 馈 + 反 馈 ” 
的 控制 结构 ， 将 参考 输入 序列 作为 未 来 参考 输入 
的 前 馈 ， 将 系统 状态 值 作为 状态 反馈 补偿 ， 通 过 
在 线 求解 ， 预 测 未 来 是 否 会 出 现 违 反 约束 的 情况 
发 生 从 而 提前 采取 适度 的 控制 作用 ， 并 通过 滚动 
优化 ， 求 解 有 限时 域内 相对 容易 的 开 环 优化 问 
题 ， 从 而 得 到 闭环 控制 ”1。 

为 防止 出 现 系统 的 控制 量 突 变 ， 影响 喷雾 机 
路 径 跟 踪 精 度 和 稳定 性 ， 用 控制 量 增 量 取 代 控 制 
量 。 修 改 后 的 状态 方程 表现 形式 如 下 。 

Xx(Klt) 

otk) a - A 

其 中 ， 夺 表示 上 时 间 对 大 时 间 的 预测 。 

设置 系统 的 状态 量 如 公式 (15) 所 示 。 

n(k) = CC (Kt) (15) 

其 中 ,w= LX, Y, o 为 离散 系统 的 输出 
量 。X 为 喷雾 机 横 轴 位 置 ，m; 7 为 纵 轴 位 置 ， 
m; 9 AMS HLA AA, (°). 

可 得 到 用 于 MPC 的 状态 空间 方程 。 

区 + 1) =AC(k) + BAu(k) 

(k) = C6 (Alt) 


(14) 


(16) 


其 中 ， 
Au(k) = i(k) DT (17) 
A-| 0 ea (18) 
Orn R 
> |B, 
B =|’ 19 
e (19) 
1 0 0 0 0 
¢.,=|0 ká 0 0 0 (20) 
0 0 后 0 0 
其 中 ，m=2 是 控制 量 维度 ，n=3 是 状态 量 维 
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图 4 372% MPC#EA 


Fig. 4 Hierarchical model predictive control block diagram 


pa 


度 ， 石 、 瑟 、 大 为 三 个 状态 量 误差 的 权重 比 。4.，， 
Bi 含义 与 公式 (13) #4, & ,为 系统 的 输出 
和 矩阵。 

考虑 到 实际 喷雾 机 中 采用 液压 推 杆 实现 转 
向 ， 其 本 号 具有 较 大 的 响应 时 间 。 同 时 ， 低 速 行 
驶 的 农药 喷洒 作业 对 系统 动态 性 能 要 求 并 不 高 ， 
而 对 作业 路 径 跟 踪 精 度 的 要 求 较 高 ，MPC 输出 
转向 角 如 出 现 较 大 超 调 势 必 会 影响 路 径 跟 踪 精 
度 。 考 虑 到 以 上 两 种 因素 ， 在 MPC 央 设 计时 ， 
通过 控制 量 及 增 量 的 约束 ， 以 符合 喷雾 机 转向 系 
统 的 实际 情况 ， 同 时 避免 转向 角 出 现 较 大 超 调 ， 
利于 喷雾 机 路 径 跟 踪 精 度 的 提升 。 
进一步 引入 松弛 因子 a， 防止 无 可 行 解 的 情 
minJ (¢, u(t — 1),Au,e) 


况 的 发 生路 。 设 置 目标 函数 如 公式 (21) m 
所 示 。 


Np 
J(t) > | tal) + 
i=1 


py AU (e+ ie) ||. + pe? 

= Y — Y YQ - Yy) + Au RAu + pe’ 
(21) 
HP, Ne ASC UM Be, MERRIE 
制 时 域 ; @ 为 系统 状态 量 的 权重 矩阵 ; R 为 系统 
Pe al tt AA FEE, AU A Pe il ee et FEE, ON 

系统 的 输出 量 。 
综 上 考虑 ， 设 置 目标 函数 的 约束 条 件 如 下 。 


st. E(k + l|t) = AC (Alt) + BAu k=tt+ 1, N,- 1 (a) 

n (klt) = c€ (klt) k=t,t+ ick, (b) 

u(k)=u(k- 1) + Au(k) k=1,t+1,....N,- 1 (c) (22) 
Unig (t +k) <u(ttk)<u,,,(t+k) k =0, 1, 2.......N, (d) 

Aunia (t + k) < Au(t +k) < Aue (t +k) 大 = 0,1, 2.....N, (e) 

Au(k) =0 k= tt Noy ese N, (f) 

e>0 


其 中 ，(a) 为 系统 的 离散 线性 时 变 运动 学 模 
型 ，(b) 为 系统 的 状态 量 ，(c) 为 系统 的 控制 
量 ，(d) 为 控制 量 约 束 ，(e) 和 (f) 为 控制 量 
增 量 约束 。 


3.2 基于 LTV-MPC 的 控制 器 设计 


将 预测 方程 进行 迭代 ， 设 置 系统 的 预测 输 
出 ， 如 公式 (23) 一 (26) 所 示 。 
Y(t) = WC (tt) + 6,AU (t) (23) 
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n(t + It) 
t+ 2I\t 
ye 7 ( |£) (24) 
n(t + Nt) 
é,,A,, 
G A, 
到 = ue 7 (25) 
č A 
cB,, 0 0 
c,,A,,B,, GB 0 
0, = : : 
Gade B AL Bo .. SAB 
(26) 


其 中 ，N, 为 预测 时 域 ， AU 为 控制 量 增 量 矩 
Me; YY 为 系统 的 输出 量 和 矩阵 ;到 和 4 为 方程 的 迭 
代 和 矩阵 。 

为 便于 使 用 MATLAB 对 目标 函数 二 次 规划 
求解 ， 将 公式 (21) 转化 成 公式 (27) 所 示 的 标 
准 形式 。 

J(t)=5X7HX + f7X (27) 


公式 (21) 进行 转化 的 具体 表现 形式 如 公式 
(28) 所 示 。 


0'O0+R ied F 


J(t) =[AU* ell ‘ i 


Ee 
[roo 01/4”) (28) 
其 中 ，E=8 (tlt)。g 为 松弛 因子 ; 0 为 系统 
状态 量 的 权重 矩阵 ; Y， 园 ，0 含 义 与 公式 (23) 
相同 。 由 于 入 U 无 法 对 EB 进行 控制 ， 在 求解 二 次 
规划 过 程 中 忽略 已 OF 项 。 为 简化 计算 ， 将 控制 
序列 中 的 第 一 个 控制 量 输出 给 被 控 系 统 ， 作 为 实 
际 的 控制 量 。 在 下 一 个 采样 时 刻 〈T+1 时 刻 ) E 
复 上 述 步 又 ， 实 现 滚动 优化 。 


3.3 驱动 轮滑 移 率 的 模糊 控制 


喷雾 机 驱动 轮 在 转向 及 复杂 的 作业 环境 下 产 
生 较 大 的 滑 移 “2 ， 往 往 会 对 喷雾 机 稳定 运行 程 
度 和 路 径 跟踪 精度 会 产生 不 利 影响 ， 因 此 需要 考 


t,t 


虑 驱动 轮滑 移 对 路 径 跟 踪 精 度 造成 的 影响 2 。 
3.3.1 驱动 轮滑 移 率 分 析 

在 Adams/Car 中 搭建 轮胎 特性 实验 平台 ， 测 
量 轮胎 滑 移 率 与 轮胎 纵向 力 之 间 的 关系 。 设 置 驱 
动 轮 的 纵向 侧 偏 刚度 C=10,000， 横 向 侧 偏 刚度 
C,=8000。 并 通过 Adams/Car 中 的 Tire Testrig 模 
块 确定 驱动 轮 纵 向 力 和 滑 移 率 关 系 ， 如 图 5 
所 示 。 


2000 
1500 
1000 
500 

0 
= -500 
“1000 

-1500 


-2000 
-100 -80 -60 -40 -20 0 20 40 60 80 100 
滑 移 率 /% 


] 力 /F 


纵 


AS 喷雾 机 驱动 轮 纵 向 力 与 滑 移 率 关系 


Fig. 5 Relationship between longitudinal force and slip 


FHS A Al, SK ob Cte 7K E420% ZA, 
轮胎 纵向 驱动 力 与 滑 移 率 近 似 呈 线性 关系 ， 可 近 
似 表示 为 公式 (29). 


F,= Cys (29) 

其 中 ,为 驱动 轮 轮胎 纵向 力 ，N; s 为 滑 移 
率 ，%， 其 定义 为 : 
Rw-y 


~ max (Rw, v) 0 


其 中 ，R，w，v 含 义 与 公式 (6) 相同 。 

将 公式 (29) 和 公式 (30) 代入 公式 (7), 
可 得 : 

T,=Jw+ RC s+T, (31) 

公式 (31) 中 各 指标 含义 和 公式 (7) 相同 。 

在 田间 复杂 作业 环境 下 ， 应 控制 轮 载 电机 输 
出 的 驱动 力矩 ， 将 驱动 轮 的 滑 移 率 控 制 在 +20% 
内 ,一 方面 喷雾 机 可 充分 利用 作业 路 面 的 附着 条 
件 获 得 较 大 纵 癌 驱动 力 ; 另 一 方面 ， 可 有 效 避 免 
由 于 驱动 轮 打滑 空转 而 产生 的 “ 刨 坑 ” 现 象 ， 导 
致 喷雾 机 整 机 沉陷 或 侧 倾 的 危险 概率 增加 。 
3.3.2 ”模糊 控制 器 设计 

模糊 控制 器 中 将 喷雾 机 的 速度 偏差 eel-1, 1] 


88 


ChinaXiv 合 作 期 刊 


202302.00197v1 


chinaXiv 


作为 模糊 控制 顺和 输入 ， 输 出 变量 ue [-0.2, 0.2] 
作为 喷雾 机 轮胎 的 期 望 请 移 率 s。 经 过 模糊 量化 


表 3 模型 预测 控制 器 参数 


Table 3 Model predictive controller parameters 


处 理 ， 根 据 隶 属 度 函 数 建立 模糊 语言 变量 和 论 域 MPC 器 参数 数值 
之 间 的 关系 。e 和 zx 的 论 域 与 七 个 量化 等 级 的 隶 采样 时 间 A 0.05 
属 度 函 数 ， 如 图 6 所 示 。 控 制 规律 为 “if A， 控制 时 域 N. 30 
then B” 形 式 ， 采 用 Mamdani 法 建立 模糊 控制 规 预测 时 域 Ni 60 
WE ( 表 2)。 采 用 MIN-MAX- 重 心 法 进行 去 模 eee "0% 
5 EHA 权重 矩阵 R 30X2, 
糊 化 ， 转 化 为 精确 量 输 出 。 车 轮转 角 上 限 /rad 0.436 
INB, NS, 0, PS, PB} 车 轮转 角 下 限 /rad -0.436 
车 轮转 角 增 量 上 限 /rad 0.05 
a \ = 车 轮转 角 增 量 下 限 /rad -0.05 
0:8 \ pys 松弛 因子 100 
0.6 \ -PS 
204 \ PB 表 4 积分 分 离 PID 控制 器 参数 
02 | Table 4 Integral separation PID controller parameters 
0 — EE 控制 器 参数 数值 
Aoo e o M T E 采样 时 间 /s 0.05 
ea UH 0.1 
图 6 e 和 7 的 隶属 函数 比例 控制 5 
Fig. 6 Membership functions of e and u 积分 控制 k 1.6 
微分 控制 ka 0.8 
表 2 模糊 控制 规则 表 = ae 网 
Table 2 Fuzzy control rules 依靠 LTV-MPC， 在 噶 盘 机 启动 和 转向 的 过 程 中 ， 
wae ET 由 于 其 左右 轮 所 处 作业 路 面 附着 系数 不 一 致 ， 导 
RA EEL 集 
-=a a o K a 致 两 侧 驱动 轮 所 受 力 大 小 不 一 致 ， 驱 动 轮 会 发 生 
u PB PS 0 NS NB 较 大 的 滑 移 ， 最 大 滑 移 率 达到 50%; 加 入 滑 移 率 


4 仿真 结果 与 分 析 


运用 MATLAB/Simulink 搭 建 基于 LTV-MPC 
的 控制 问 和 请 移 模 糊 控制 需 ， 与 Adams View 搭 
建 的 喷雾 机 模型 进行 联合 仿真 。MPC 器 参数 设置 
如 表 3 所 示 。 积 分 分 离 PID 控制 器 参数 设置 如 表 4 
所 示 。 

本 研究 以 对 开路 面 的 U 型 路 径 和 3D 随机 路 
面 的 8 字形 路 径 两 种 工 况 进行 了 分 析 。 


4.1 工 况 一 : 对 开路 面 的 U 型 路 径 跟踪 


设置 喷雾 机 左右 驱动 轮 的 路 面 附着 系数 分 别 
为 03 和 0.7 的 对 开路 面 的 。 参 考 路 径 依然 为 连 
续 的 U 型 弯 ， 半 径 为 10 m。 

图 7 为 对 开路 面 的 U 型 路 径 喷雾 机 驱动 轮 的 
滑 移 率 。 在 路 面 附 着 系数 发 生变 化 的 情况 下 ， 仅 


模糊 控制 需 后 ， 在 启动 和 转向 的 过 程 中 ， 能 将 滑 
移 率 控制 在 +20% ZA. 

图 8 为 对 开路 面 情 况 下 喷雾 机 前 轮转 向 角 。 
仅 依靠 LTV-MPC， 在 喷雾 机 启动 和 转向 过 程 中 ， 
驱动 轮滑 移 致使 喷雾 机 转向 角 会 产生 较 大 超 调 ， 
对 喷雾 机 的 稳定 性 和 跟踪 进度 产生 不 良 影响 ; 加 
入 滑 移 率 模 糊 控制 器 后 ， 能 够 减少 转向 角 的 超 
调 ， 实 际 转向 角 为 +4.866"。 

喷雾 机 在 对 开路 面 情况 下 的 横向 偏差 和 跟踪 
的 实际 情况 如 图 9 和 图 10 所 示 。 在 对 开路 面 情况 
下 跟踪 路 径 的 过 程 中 ， 了 驱动 轮滑 移 对 喷雾 机 横向 
偏差 产生 影响 。 仅 依靠 LTV-MPC， 在 喷雾 机 启 
动 和 转向 过 程 中 ， 驱 动 轮滑 移 致 使 喷雾 机 转向 角 
会 产生 较 大 超 调 ， 因 而 对 整 机 的 路 径 跟踪 精度 产 
生 影 响 ， 最 大 横向 偏差 为 0.032 m; 加 入 滑 移 率 
模糊 控制 器 后 ， 能 够 减少 转向 角 的 超 调 ， 最 大 横 
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m8 Fe wise (考虑 滑 移 率 ) 
0.4r 一 左前 轮 ( 未 考虑 滑 移 率 ) 
0.3 
at 0.2 上 
d oi} 
Be 
0 
-0.1 F 
-0.2 
0 30 
m 
(a) 左 前 al it? a 骨 移 率 对 比 
ol) T oT 三 右前 轮 (考虑 滑 移 率 ) 
| [一 右前 轮 (未 考虑 滑 移 率 ) 
-02 L L 1 L L 
0 10 30 70 80 90 100 110 
时 las 
(b) 右 前 轮滑 移 率 对 比 


图 7 对 开路 面 驱动 轮滑 移 率 对 比 


Fig. 7 Comparison of driving wheel slip rates on off road 


Ai 角 (考虑 滑 移 ) 
3 向 角 (未 考虑 滑 移 ) 
a) 
dl 
< 0 
i-l 
E2) 


-6 
4 1 1 | 
0 10 60 70 90 100 110 
时 间 /s 
2 65| £ 
2 i | ~ 6 i 
X] A | x55 
ia 用 x 
还 F RS 
0 er rrr En 
a 4.5 
Li a > J = 
1 2 4 & So 6° 4 21 22 23 24 25 26 
时 间 /s 时 间 /s 


图 8 对 开路 面 喷雾 机 前 轮转 角 


Fig. 8 Front wheel angle of sprayer on off road 


向 偏差 为 0.018 m， 提 高 了 喷雾 机 在 复杂 作业 环 
境 中 路 径 的 跟踪 精度 。 


4.2 工 况 二 : 3D 随机 路 面 的 8 字形 路 径 
跟踪 
为 进一步 测试 路 径 跟 踪 控 制 在 真实 复杂 作业 


路 面 下 的 有 效 性 ， 基 于 路 面 不 平 程度 分 类 标 
YE °° 和 Adams 的 三 维 (3D) 路 面 节 点 算法 O 


oog 。 FRERE GERE) 
0.03| 横向 偏差 (未 考虑 滑 移 | S 
0.02 8 > as 


0 10 20 30 40 50 60 70 80 90 100 110 
时 间 /s 
图 9 对 开路 面 喷雾 机 横向 偏差 


Fig. 9 Sprayer lateral deviation on offroad 


一 实际 路 径 (考虑 滑 移 ) 
BSE 


ne 一 实际 路 径 (未 考虑 滑 移 ) 
三 
= 20 

15 

10 


A ` t, ? 
-0.01 0 0.01 0.02 29.98 29.99 30 30.0 
X 轴 /mm X 轴 /m 


图 10 对 开路 面 情 况 参 考 路 径 与 实际 路 径 
Fig. 10 Reference path and actual path on offroad 
在 MATLAB 中 生成 如 a 11 oS C 等 级 随机 路 
面 模型 。 在 3D 路 面 上 ， 进 行 8 字 型 路 径 跟 踪 的 
联合 仿真 


q(X,Y)/m 
© 


40 


Y/m -20 " 0 
a -40 -40 ° X/m 


All C 级 平整 度 随 机 路 面 


Fig. 11 Random pavement with c-level roughness 


在 C 等 级 随机 路 面 情况 下 喷雾 机 驱动 轮 的 滑 
移 率 如 图 12 所 示 。 由 于 路 面 起 伏 不 平 ， 驱 动 轮 
和 地 面 的 接触 面积 减 小 ， 更 易 导 致 驱动 轮 产 生 过 
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度 滑 移 ， 降 低 喷雾 机 的 稳定 性 和 跟踪 性 能 。 在 启 
动 过 程 中 ， 喷 雾 机 产生 :20% 左 右 的 滑 移 率 ,在 
跟踪 直线 的 过 程 中 ， 由 于 路 面 平整 度 发 生变 化 ， 
驱动 轮 的 滑 移 率 有 一定 波动 ， 但 能 控制 在 :20% 
之 内 ， 在 转向 的 过 程 中 ,由 于 存在 侧 借 作 用 对 喷 
雾 机 稳定 性 产生 影响 ， 驱 动 轮 的 滑 移 率 有 较 大 波 
动 ， 滑 移 率 能 够 基本 保持 在 +20% 内 。 


wl 


图 12 C 级 平整 度 随 机 路 面 下 驱动 轮滑 移 率 
Fig. 12 Driving wheel slip rate with c-level roughness 
C 级 平整 度 随 机 路 面 情况 下 喷雾 机 的 车 速 和 
转向 角 的 波形 如 图 13 和 图 14 所 示 。 驱 动 轮 发 生 
滑 移 会 对 车 速 和 转向 角 产 生 影响 。 由 于 路 面 不 平 


整 ， 在 跟踪 路 径 的 过 程 中 ， 喷 筋 机 的 速度 和 转向 
角 会 发 生 波动 ， 但 控制 算法 能 够 及 时 对 驱动 轮转 
和 矩 和 转向 角 进 行 调整 ， 控 制 喷雾 机 的 车 身 姿 态 ， 
防止 喷雾 机 偏离 预期 的 参考 路 径 。 转 向 角 的 波动 
较 大 ， 最 大 转向 角 为 7.71°。 


0 10 30 30 40 30 60 7 30 30 100 110 120 130 140 
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图 13 C 级 平整 度 随机 路 面 下 喷雾 机 速度 


Fig. 13 Sprayer speed of c-level roughness road 
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图 14 C 级 平整 度 随 机 路 面 下 喷雾 机 转向 角 


Fig. 14 Sprayer steering angle of c-level roughness road 


C 级 平整 度 随机 路 面 情 况 下 的 喷雾 机 的 横向 
偏差 如 图 15 所 示 。 在 启动 过 程 中 ， 喷 雾 机 产生 
较 大 的 滑 移 率 ， 导 致 车 速 和 转向 角 发 生 波动 。 因 
此 在 跟踪 直线 的 过 程 中 ， 喷 雾 机 横向 偏差 发 生 波 
动 ， 最 大 横向 偏差 0.0057 m。 喷 雾 机 在 转向 的 过 
程 中 ， 由 于 路 面 不 平整 ， 存 在 侧 倾 作 用 对 喷雾 机 
稳定 性 产生 影响 ， 转 向 角 连 续 波 动 导 致 喷雾 机 的 
横向 偏差 偏 大 ， 最 大 横向 偏差 为 0.058 m。 在 C 
级 平整 度 随 机 路 面 情况 下 的 跟踪 路 径 结 果 如 图 16 
所 示 。 喷 筋 机 在 复杂 的 工 况 条 件 下 依然 能 够 准确 
的 跟踪 期 望 路 径 ， 通 过 控制 驱动 轮 的 滑 移 率 ， 防 
止 驱动 轮 出 现 打 清空 转 ， 提 高 了 喷雾 机 的 稳定 性 
和 控制 精度 。 结 果 表 面 该 控制 算法 能 够 满足 复杂 
工 况 条 件 的 要 求 。 
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图 15 C 级 平整 度 随 机 路 面 下 喷雾 机 横向 偏差 


Fig. 15 Lateral deviation of sprayer of c-level roughness road 


一 实际 路 径 
一 参考 路 径 
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图 16 C 级 平整 度 随机 路 面 下 参考 路 径 与 实际 路 径 
Fig. 16 Reference path and actual path of c-level 


roughness road 
5 结论 


本 人 研究 针对 4W 了 DD 高 地 际 喷 雾 机 独特 的 前 后 
双 转 向 桥 与 4WID 的 同步 转向 结构 ， 分 析 并 建立 
了 基于 MPC 的 LTV 运动 学 模型 ， 考虑 到 驱动 轮 
发 生 过 度 滑 移 会 降低 喷雾 机 的 稳定 性 和 跟踪 路 径 
精度 ， 以 MPC 和 模糊 滑 移 率 控制 构成 了 分 层 的 
4WID 喷雾 机 的 路 径 跟 踪 控 制 策略 ， 提 高 喷雾 机 
在 泥 洗 湿 滑 等 复杂 农田 作业 环境 下 的 路 径 跟 踪 精 
度 。Adams/Matlab 仿真 结果 表明 ， 本 研究 提出 的 
基于 LTV-MPC 和 滑 移 模 糊 控制 的 控制 器 在 复杂 
作业 工 况 下 ， 控 制 喷雾 机 的 稳定 性 和 跟踪 精度 均 
优 于 仅 依靠 LTV-MPC 方式 就 行 控制 ， 能 够 减少 
喷雾 机 转向 角 的 超 调 ， 快 速 精准 地 控制 车 速 和 转 
向 角 ， 同 时 将 驱动 轮 请 移 率 控制 在 +20% ZA, 


有 效 减少 了 跟踪 路 径 的 横向 偏差 ， 提 高 了 喷雾 机 
在 复杂 作业 环境 下 的 路 径 跟 踪 精 度 。 

后 续 将 搭建 日 本 艾 安 得 A&D 控制 仪表 
(A&D5436) 实验 平台 对 本 研究 提出 的 路 径 模型 
预测 控制 进行 实验 验证 。 同 时 将 进一步 讨论 喷雾 
机 由 于 垂直 载荷 的 变化 产生 的 侧 倾 对 喷雾 机 的 稳 
定性 和 控制 精度 的 影响 并 在 模型 中 加 入 针对 侧 倾 
的 综合 等 效 约束 。 
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Path Following Model Predictive Control of Four Wheel 
Independent Drive High Ground Clearance Sprayer 


WANG Zijie, LIU Guohai , ZHANG Duo, SHEN Yue, YAO Zhen, ZHANG He 


(School of Electrical and Information Engineering, Jiangsu University, Zhenjiang, 212013, China) 


Abstract: In order to solve the problems of low transmission efficiency, high carbon emissions, environmental pollution, low in- 
telligence, and poor flexibility in traditional fuel-driven and front-wheel steering high ground clearance sprayers, a new type of 
high ground clearance four-wheel independent drive (4WID) sprayer which was suitable for the unmanned driving was pro- 
posed in this research. The sprayer adopted the hybrid power of fuel and battery and was steered by the 4WID driving mode of 
the front and rear double steering axles. For this reason, the turning radius of the proposed 4WID sprayer was small, and the run- 
ning track of the front and rear wheels were uniform in height, which reduced the phenomenon of seedling crushing during field 
plant protection operations. Considering the slippage and sinking of the driving wheel in the extremely complex operating envi- 
ronment of the paddy field, based on the linear time-varying kinematics model (LTV) of the sprayer, a layered path tracking con- 
trol considering the slippage of the driving wheel was constructed. The upper model predictive controller (MPC) obtained the 
steering angle and movement speed of the sprayer according to the expected path and the current position of the vehicle to real- 
ize path tracking. The lower layer used fuzzy control and integral separation PID control to construct a driving wheel slip con- 
troller, so as to achieve effective control of path tracking, speed, and driving wheel slip, which improved the stability and path 


tracking accuracy of the sprayer in a complex operating environment. The co-simulation results of Adams and Matlab showed 


that under complex working conditions, the slip rate of the driving wheel of the sprayer was controlled within +20%, so as to 
prevent excessive slip of the driving wheel from having adverse effects on the speed and steering angle, which was conducive to 
the improvement of the stability of the sprayer. The sprayer could be tracked quickly and accurately the desired path, the path 


tracking in road conditions outside attached coefficients were 0.3 and 0.7 of the lateral deviation could be controlled within 


+0.018 m. In stage C roughness 3D road conditions, the sprayer could adjust the steering angle of the front wheels in time to sta- 


bilize the body posture and the lateral deviation could be controlled within +0.054 m. Compared with the controller that didn't 
consider the slip of the driving wheel, the stability and path tracking accuracy of the sprayer had been significantly improved. 
Key words: front and rear double steering axles; four-wheel independent drive; model predictive control; fuzzy control; slip; 


path tracking 
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